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CONFIGURATION  SPACE  CONTROL 


Berthold  K.  P.  Horn  and  Marc  H.  Ralbeft 


^STMCT.  Complicated  systems  with  non-linear  time-varying  behavior  are 
difficult  to  control  using  classical  linear  feedback  methods  applied 
separately  to  individual  degrees  of  freedom.  At  the  present,  mechanical 
manipulators,  for  example,  are  limited  in  their  rate  of  movement  by  the 
inability  of  traditional  feedback  systems  to  deal  with  time-varying 
inertia,  torque  coupling  effects  between  links  and  Coriolis  forces. 
Analysis  of  the  dynamics  of  such  systems,  however,  provides  the  basic 
information  needed  to  achieve  adequate  control. 

Implementation  of  a control  system  based  on  such  analysis  is 
not  straightforward,  however,  since  impractical  amounts  of  computation 
or  memory  may  be  called  for.  We  propose  a new  method  that  balances  the 
trade-off  between  computational  and  storage  costs.  The  actuator  torques 
required  to  move  a manipulator  along  a trajectory  are  calculated  using 
coefficients  found  in  a look-up  table  Indexed  by  the  configuration  of 
the  manipulator.  Feedback  plays  only  an  indirect  role  in  correcting  for 
small  differences  between  the  state  of  the  actual  device  and  that  of  a 
dynamic  model. 

This  report  describes  research  done  at  the  Artificial  Intelligence 
Laboratory  of  the  Nsssachusetts  Institute  of  Technology.  Support  for  the 
laboratory's  artificial  intelligence  research  is  provided  In  part  by  the 
Office  of  Naval  Research  of  the  Department  of  Defense  under  ONR  contract 
N00014-77-C-0389. 


— * now  at  the  Jet  Propulsion  Laboratory,  California  Institute  of  Technology, 

( Pasadena,  California  91103. 
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MOTIVATION. 

The  application  of  Industrial  manipulators  to  parts  transfer  Is  still 

limited  by  their  high  cost.  A useful  figure  of  merit  for  such  a device  Is  I 

the  ratio  of  the  number  of  operations  It  can  perform  per  unit  time  to  Its 

cost.  The  more  cycles  the  manipulator  performs  per  unit  time,  the 

more  rapidly  It  Mill  pay  back  the  Investment.  There  Is,  we  believe,  a 
threshold  for  this  figure  of  merit  above  which  the  application  of 
machine  manipulation  to  a wide  variety  of  tasks  becomes  economically 
feasible.  If  the  figure  of  merit  were  to  rise  above  this  threshold,  the 
Increase  In  feasibility  would  make  mass  production  of  manipulators 
possible,  resulting  In  further  drops  In  unit  cost  and  yet  wider  application. 

It  Is  unlikely  that  this  revolutionary  sequence  of  events  will  be 

I 

triggered  by  a reduction  In  the  cost  of  manipulators,  since  the  technology 
for  building  reliable  devices  In  the  numbers  now  used  appears  fairly  stable. 

It  Is  possible,  however,  to  decrease  task  cycle  times  with  equally  dramatic 
results.  Decreasing  cycle  time  means  Increasing  the  rate  of  manipulation  — 
the  speed  the  arm  moves  during  transfer  and  during  manipulation. 

Presently,  many  mechanical  manipulators  are  limited  by  their  controllers. 

\ 

Such  systems  typically  employ  simple,  fixed  analog  servo  loops  closed 
separately  around  each  degree  of  freedom.  Though  suitable  for  control  of 
a set  of  Independent  second-order  systems  with  fixed  Inertias  and  damping, 

I 

such  control  Is  not  appropriate  for  devices  with  non-linear,  time-varying  ^ 

behavior.  Performance  Is  adequate  at  low  speeds  provided  the  actuators  are 
strong  enough  and  the  properties  of  the  devices  do  not  change  too  dramatically 
with  configuration.  At  higher  speeds,  however,  problems  are  caused  by:  ' || 
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(1)  Varying  affactive  nomants  of  Inartia* 

(2)  Torqua  coupling  batMaan  dagraas  of  fraadom,  and 

(3)  Coriolis  forcas  proportional  to  valodty  product  terms. 


Naturally,  other  factors,  such  as  the  mechanical  strength  of  the  device 
and  the  pomer  available  from  the  actuators,  also  limit  ultimate  performance. 
For  many  manipulators,  however,  these  are  not  the  limiting  factors. 


Mtanow  tm 

mt  mti  iNtM 

He  Ml  SKtiM  □ 

MMioaiita  □ 

jminuTiM 


IT 

OBTHiniM/ATAIUItLITT  CMO 

itot.  AT/iiL  lii</ir  mtcm 


BACKGROUND. 


Mechanical  manipulators  used  for  parts  transfer  t/plcally  consist  of 
rigid  components,  called  links,  attached  to  each  other  at  Joints,  each  joint 
being  powered  by  an  actuator  (see  for  example  figure  1).  Measurements  of 
joint  position  and  velocity  are  available  to  the  control  system  that 
supplies  commands  to  the  actuators.  Most  commonly,  manipulators  are  attached 
to  a fixed  base  at  one  end  and  carry  a terminal  device  or  tool  at  the  other. 
The  time- varying  actuator  commands  are  Intended  to  cause  this  terminal  device 
to  follow  a given  trajectory  through  space. 

Marof  arrangements  of  links  and  joints  are  possible;  In  this  paper,  we 
concentrate  on  a kinematic  chain  arranged  In  a popular  serial  or  cascaded 
structure  using  rotary  joints.  This  choice  allows  us  to  be  concrete  and 
to  avoid  repeated  use  of  phrases  such  as  "joint-angle  or  joint-extension" 
and  "actuator  torque  or  actuator  force".  Similar  methods  apply  to  devices 
with  linear  motions  and  to  those  with  parallel  degrees  of  freedom. 

The  particular  device  shown  In  figure  1 was  designed  and  built  by 
Victor  Schelnman  for  the  Artificial  Intelligence  Laboratory  [1].  It  has 
six  degrees  of  freedom,  the  minimum  necessary  to  reach  points  In  the  work 
space  with  arbitrary  orientation  of  the  terminal  device.  This  amnlpulator 
Is  driven  by  six  direct  current  torque  motors,  and  has  potentiometers  for 
joint-angle  measurement  and  tachometers  for  joint-angle-retes  or  angular 
velocities.  The  supporting  electronics  permit  direct  control  of  motor  currents 
and,  consequently,  actuator  torques. 
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We  designate  the  angle  of  the  1 Joint,  and  0^  the  angular  velocity 

•• 

of  this  joint.  Similarly,  6^  Is  the  angular  acceleration  and  the  torque 
applied  by  the  1^^  actuator.  Frequently  It  Is  helpful  to  group  values  for 
all  degrees  of  freedom  using  vector  notation.  Thus  for  a system  with  n 
degrees  of  freedom,  we  call  0 the  configuration,  where: 


0 * ( O'! » ^3*  ••••  0p) 

Similarly,  we  refer  to  the  combination  of  0 and  0 as  the  state,  where: 

• • • • • 

0 * (6^,  02*  ....  0j^) 

The  torque  vector  Is  similarly  defined  as 


! ■ (Tf  V T3 T„) 

With  this  notation  we  see  that  the  function  of  the  control  system  Is  to 
produce  appropriate  actuator  torques  T(t),  so  that  the  actual  Joint 
angles,  0*(t),  follow  a given  trajectory  of  desired  Joint  angles,  B^{t) 
(see  figure  2).  We  will  see  later  that  this  task  may  at  times  be  simplified 
If  the  control  system  also  has  access  to  both  actual  angular  velocities, 
0*(t),  as  well  as  desired  angular  velocities,  0 (t). 
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A SYSTEM  WITH  ONE  DEGREE  OF  FREEDOM. 

To  Introduce  some  of  the  notions  used  later  on,  let  us  consider  a very 
simple  system  Illustrated  In  figure  3 — a one  degree-of- freedom 
"manipulator".  Here  a motor  produces  a torque,  T,  which  drives  a shaft.  The  shaft 
carries  a rod  of  mass  m and  length  l.  The  angular  departure  from  vertical,  6, 

Is  measured  by  a potentiometer,  while  a tachometer  measures  the  angular 
velocity*  6>  Clearly  the  system  Is  governed  by  an  equation  of  the  form 

T ■ I e - k s1n(e) 

2 

where  I ■ mt  /3,  g Is  the  acceleration  due  to  gravity  and  k ■ (m£/2)g. 

A typical  control  system  for  such  a second-order  system  Is  shown  In  figure  4. 
Here. 

T • a (0**  - e*)  + o (0**  - 0*) 

where  the  superscripts  denote  desired  and  actual  values,  while  a and  a 
are  parameters  yet  to  be  determined.  Combining  the  two  equations  we  find 

I 0*  ♦ a 0*  ♦ (a  0*  - k s1n(0®))  - a 0**  ♦ o 0^ 

If  the  actual  angle,  0®,  Is  to  fbllow  the  desired  angle  0^  closely,  a » k. 

In  this  case,  the  poles  of  the  system  are  approximately  at  the  roots  of  the 
polynomial 


I s^  ♦ as 


+ a ■ 


0 


•6- 


That  1s» 

- 8 ± /b^  - 4 a I 

s ■ 

2 I 

The  speed  of  response  of  the  overall  system  depends  on  / a / I ; so.  for 
rapid  response,  o s1]ou1d  be  large. 

To  obtain  good  damping  of  transient  oscillations,  we  choose  8 so  that 
B “ 2 / a I.  The  details  of  this  are  not  very  Important  other  than  to 
show  that  such  feedback  systems  can  achieve  adequate  control  of  simple 
second-order  mechanical  systems  and  that  the  paramecers  of  the  feedback 
system  must  be  chosen  by  considering  the  parameters  of  the  system  Itself. 
When  system  parameters  chai^  a different  set  of  feedback  parameters 
Is  used  to  provide  best  performance. 

If  the  parameters  of  the  system  vary  greatly  and  the  control  system 
Is  not  altered,  unsatisfactory  performance  can  be  anticipated.  This  may 
take  the  form  of  sluggish  response,  excessive  overshoot,  or  undamped 
oscillations. 
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IMVERSE  SYSTEMS. 


Analysis  of  the  dynamics  of  a system  often  leads  to  equations  that  can 
be  used  to  Implement  an  "Inverse"  system.  The  system  originally  analyzed 
can  be  viewed  as  an  analog  computer  for  calculating  position  (and  Its 
derivatives)  given  actuator  outputs,  while  the  Inverse  system  computes 
actuator  outputs  from  position  (and  Its  derivatives).  A simple  Illustration 
will  make  this  clear. 

A one  degree-of-freedom  system  was  shown  In  figure  3.  governed  by  the 
equation 

I e - k sln(e)  ■ T 

This  system  can  be  viewed  as  an  analog  computer  solving  this  differential 
equation  for  6(t)«  given  the  Input  T(t).  If  the  constants  In  the  equation 
are  known,  one  can  turn  this  analysis  around  and  calculate  the  values  of 
torque,  T(t),  needed  to  achieve  the  desired  Joint-angle  variations  with 
time,  e(t).  This  Inverse  procedure  Is  Important  In  solving  the  control 
problem.  An  open-loop  control  system  based  on  this  notion  Is  shown  In 
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figure  5a.  We  will  take  up  later  the  question  of  errors  in  trajectory 
which  result  from  small  differences  between  the  actual  system  and  the 
model  used  in  deriving  the  Inverse  system.  For  now,  note  that  in  view 
of  this  possibility  the  actual  state  of  the  system  should  be  used  in 
the  inverse  calculation  rather  than  the  desired  state  (see  figure  5b). 
With  this  modification,  the  inverse  system  takes  as  its  prime  input  the 
angular  acceleration,  and  produces  actuator  torque  as  its  output. 

The  straightforward  kind  of  control  based  on  an  inverse  system  and  il- 
lustrated here  applied  to  a linear,  time-invariant,  one  degree-of-freedom 
system,  will  now  be  extended  to  control  of  more  complex  systems  such  as 
manipulators.  Before  we  can  do  this,  we  have  to  understand  the  dynamics 
of  these  devices.  Considerable  work  has  been  done  in  this  area  as  can  be 
seen  from  references  [2,  3,  4.  5,  6,  7,  8]  for  example. 
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DYWMICS  OF  MANIPULATORS. 

The  most  direct  route  leading  to  a detailed  understanding  of  the  dynamics 
of  a complex  mechanical  system  tuch  as  a manipulator  Is  an  analysis  based  on  the 
Euler-Lagrange  equations  [8]. 


Here  the  represents  generalized  coordinates.  generalized  forces  and  L Is 
the  Lagranglan,  or  "kinetic  potential", 

L - K - P 


where  K Is  the  kinetic  energy  and  P the  potential  energy  of  the  whole  system. 

In  our  case  the  most  convenient  generalized  coordinates  are  the  Joint-angles, 
e^,  and  then  the  generalized  forces  become  the  actuator  torques  T^.  Further- 
more, since  the  potential  energy  Is  a function  of  Joint-angles  only.  It  Is  coh- 
venlent  to  separate  the  calculation  of  torques  required  to  compensate  for  gravi- 
tational forces. 


from  the  calculation  of  torques  required  to  support  the  motion  If  gravity  were 
not  present 
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Also.  since  the  total  kinetic  energy  Is  the  sum  of  the  kinetic  energies  of 
each  of  the  links.  It  Is  helpful  to  separate  the  calculation  Into  components 
of  the  form. 


where  T^j  Is  the  torque  required  of  the  1^**  actuator  to  support  the  motion  of 
the  link.  The  total  torque  required  at  etch  actuator  Is  then  obtained  by 
summation  of  these  terms. 

The  derivation  of  the  Euler-Lagrange  equations  requires  difficult  mathe- 
matical arguments;  however  the  use  of  these  equations  Is  straightforward. 
Application  of  these  equations  to  manipulator  control  was  pioneered  by  dicker 
Pleper,  Kahn  and  Paul  [5,  6,  7,  8J.  A practical  difficulty  Is  the  potentially 
explosive  growth  In  algebraic  manipulation  that  accompanies  analysis  of 
systems  with  several  degrees  of  freedom.  A computer  system  such  as  MACSYMA 
[9],  able  to  carry  out  manipulations  of  symbolic  mathematical  expressions  Is 
very  helpful  In  these  cases. 

Much  of  the  earlier  work  on  this  problem  made  use  of  a general  representa- 
tion, with  a coordinate  system  erected  In  each  link  and  matrices  describing 
the  transformations  between  coordinate  systems  of  connected  links  [5,  6,  7,  8]. 
While  perfectly  general,  this  kind  of  analysis  leads  to  very  complicated  re- 
sults and  the  need  to  perform  thousands  of  arithmetic  operations  In  order  to 
calculate  required  Joint- torques.  All  hope  of  performing  these  calculations 
In  real-time  was  abandoned  as  a result. 
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ILLUSTRATION  USING  THE  SINGLE  DE6REE-0F-FREED0M  SYSTEM. 

For  the  system  shoMn  In  figure  3.  It  Is  clear  that  K ■ j le^  and  P ■ k cose, 
sc  that 

L ■ y le*  - k cose 


Consequently, 


T-3t<ly) 


3k 

ae 


gives  us 

T ■ I8  - k sine 

as  before.  Here,  of  course,  little  Is  gained  by  using  this  method.  It  Is, 
hoMever,  Invaluable  for  complex  devices. 
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DYNAMICS  OF  A THREE-LINK  DEVICE. 

Recent  work  has  shown  that  some  devices  can  be  analyzed  easily  If  cal* 
eolations  use  joint-angles  directly  and  If  links  are  modelled  as  thin  rods  [10, 
11,  12,  13].  As  an  example,  we  present  the  results  for  a three- link  device 
with  offsets  shown  In  figure  6.  This  corresponds  to  the  first  three  joints 
of  the  arm  discussed  earlier,  shown  In  figure  1. 

T,  . [I,  ♦ r *l>  * "3<*I4  ♦ *2*3*2*23  * r *l3  * ' 

^2*’2^2  * 2~  * *"3^23^^  ®2  ” 

*3*3*23^  *^3  * 


C"2  *2*2  * "'3t2*i*2*2  * *2*3^*2*23  * *2*23^  * 3 *23*23^  ^1*2  * 

*2^2*2  * ^ *3^^  *^2*2  * ^3*23^^  H * tV3*3*23^  ^®3  * 

®3*’3*23^  H ^"’3^3*^23^*’2®2  “IT  ®23^^  ®3®1 
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Tg  - -[j-  *2*2^2  2"  * ^3^23^^  *®1  * 


tl  .. 

[iBg  j-  + ">3(^1  *2*’3®^T"^^®2  * 


m.  Zl\ 

C?"  ^*'2*^3®3  ■*’  T"^^*®3  ‘ 


m 


2l^ 


[0*2  / SgCg  + / (2i|s2C2  + *2*3^‘^2®23  * *2*^23^  T *23*=23^  ' 


1D« 


IlM  • 

^^3^2^3^3^^2^3  ~ ^2^3^3^  ^3  ” 


[m2  2^  *2  + m3(t2S2  + ^T  *23^^^ 


iv  ^rJf..^  . 3\i  *«  . r- 


T3  » -[j-  *3^3‘^23^  ^1  ^ ^5^  ^^2^3‘^3  ®2  * ^'"3  F^®3  " 


[5^  *3^23^ ^2®2  * ~r  ®23^^®f  * ^2^  *2*3®3  ^ ®5  “ 


[m3  j-  S23]  9 


Here  t2*  *3  *''**  the  lengths  of  the  three  links.  The  upright  column  Is 
modelled  as  a cylinder  with  Inertia  about  Its  axis,  while  the  other  two  links 
are  modelled  as  thin  rods  of  mass  m2  and  m^  respectively.  An  offset  of  fig 
occurs  between  the  long  axis  of  the  upright  column  and  the  plane  In  which  the 
second  link  rotates.  A similar  offset  fij  separates  the  plane  In  which  link  3 
rotates  from  this  vertical  axis  (see  figure  6). 


. ( 


. 1 

! i 


( 
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A shorthand  notation  Is  used  for  trlgononetrlc  terms.  That  is, 

- cos(8^)  - sin  (0^) 

and 

» cos(e^  + 0j)  s^j  » sin{0^  + Oj) 

The  terms  containing  e^,  or  are  Inertial  torques  (required  to  ac- 

celerate the  links),  while  terms  containing  angular  velocity  products  of  the 
form  are  Coriolis  force  components.  The  third  class  of  terms  contain  g, 
the  gravitational  constant,  and  are  thus  the  torques  required  to  compensate 
for  the  gravitational  load. 

Roughly  a hundred  arithmetic  operations  are  required  to  calculate  the  re- 
quired Joint  torques  given  Joint  angles,  e,  and  angular  rates,  §,  as  well  as 
desired  accelerations,  *e.  Such  a direct  calculation  might  be  used  as  the 
basis  of  a control  system.  In  fact,  If  6^  and  6^  are  zero,  several  terms 
fall  out  and  the  calculation  becomes  simpler.  If,  on  the  other  hand, 
we  consider  a device  with  either  more  degrees  of  freedom  or  links  that  have  to 
be  modelled  by  full  Inertia  matrices.  Instead  of  the  diagonal  form  appropriate 
to  thin  rods,  then  these  calculations  become  quite  Intractable  (For  an  example, 
see  appendix  A In  reference  [7]). 


WHY  THE  STRAI6HTF0RWARD  CONTROL  METHOD  FAILS. 

If  we  look  at  the  equations  for  the  actuator  torques  we  see  that  they 

have  some  characteristics  that  make  control  more  complex  than  It  Is  for  a 

simple  one  degree-of-freedom  second-order  system.  First  of  all,  the 
•• 

coefficients  of  6^  In  the  expression  for  are  not  constant.  Indicating 
variable  effective  Inertia.  Ordinarily,  as  we  have  seen,  the  feedback 
coefficients  are  constants  tuned  for  proper  operation  at  some  fixed  Inertia, 
so  control  will  not  be  good  for  Inertias  very  different  from  this  design 
value. 

•• 

Next,  one  sees  that  there  are  terms  containing  Sj  In  the  expressions 
for  T^,  when  1 f J.  This  cross-coupling,  too,  may  produce  problems  since 
accelerations  of  one  Joint  require  coordinated  torques  at  all  Joints.  Loops 
closed  separately  around  each  Joint  cannot  easily  deal  with  this  problem. 

Finally  one  sees  numerous  Coriolis  force  terms,  multiples  of  products 

I 

of  Joint-angle-rates.  At  high  speeds,  these  dominate  the  Inertial  and 
gravitational  torques,  and  actuator  torques  produced  by  traditional  | 

control  systems  may  not  be  appropriate  for  stable  control.  Such  problems  | 

become  most  significant  for  long  movements,  when  velocities  can  build  up  i 

to  a point  where  velocity  product  terms  exceed  acceleration  terms.  | 
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FORM  OF  THE  EQUATIONS  OF  MOTION. 

We  now  examine  the  form  of  the  equations  for  the  actuator  torques  In 
an  attempt  to  find  a reasonable  computing  scheme  for  control  of  such  a 
device.  Clearly  each  torque  Is  a function  of  joint  angles,  6,  angular 
rates  6.  and  angular  accelerations,  e.  One  approach  then  Is  to  calculate 
the  required  actuator  torques  directly  from  the  equations;  techniques 
used  by  Paul  are  similar  to  this  [8].  In  most  cases,  however,  this  approach 
Involves  an  Inordinate  amount  of  computing  time  and  drastic  simplifications 
have  to  be  Introduced  to  make  this  at  all  feasible  [8]. 

The  other  extreaie  Isjbased  on  a look-up  table  Indexed  on  6,  6 and  6. 
Each  of  the  dimensions  Is  quantized  Into  m Intervals.  No  calculation  Is 
required,  but  the  look-up  table  has  3 n dimensions  for  a device  with  n 
degrees  of  freedom  and  Is  thus  quite  unmanageable  even  when  each  dimen- 
sion Is  quantized  coarsely,  that  Is,  when  m Is  small.  If  we  use  the 
convention  that  subscripts  correspond  to  variables  with  discrete  sets  of 
values,  then  we  may  represent  this  scheme  by  the  equation 

^1  “ ^,(e,S,0) 

mm 

where  the  values  of  F^  are  pre-calculated  for  a discrete  set  of  values  of 
6,  8 and  6,  and  stored  In  a table  [14j.  Albus'  manipulation  scheme  Is 

mm  mm  mm 

similar  to  this  [IS]. 

Fortunately,  however,  the  torques  are  linear  functions  «f  the 
accelerations,  as  we  have  seen,  and  the  equation  can  be  rewritten  In  the 
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fonn 

n 

T.  - KWj.e)  + I I<4(0.S)*#4 

1 1 - j - 1 J 

This  leads  to  a second  Implementation,  using  one  look-up  table  for  and  one 
for  both  Indexed  on  9 and  e.  These  tables  are  now  only  of  dimension  2n. 

The  computation  required  after  table  look-up  Is  simplje,  namely  n multiplications 
and  additions  per  joint.  Ralbert's  manipulator  control  schemes  are  based  on 
a similar  formulation  of  the  problem  Cl6,17j.  He  derives  the  table  entries  by 
"learning"  rather  than  calculation  from  the  model  — that  Is.  the  manipulator 
performs  test  motions  to  estimate  experimentally  the  multipliers  and  I^j. 

In  general  the  look-up  tables  are  still  too  large  to  be  useful.  (In  the 
equation  above,  the  Inertial  terms  I^j  are  written  as  functions  of  both  angles 
and  angular  rates  to  Indicate  the  Indexing  of  look-up  tables  In  this  scheme. 

In  fact,  the  Inertial  terms  do  not  depend  on  the  angular  rates,  something  we 
win  exploit  next.) 
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CONFIGURATION  SPACE  COWTKOL. 


It  turns  out  that  th«  tquatlons  h«vf  a rather  special  fore  [8,  10]  and  can 
be  written  as 


This  Is  a consequence  of  the  form  of  the  expressions  for  the  Lagranglan. 

Here,  Is  the  gravity  compensation,  I^j  are  Inertial  terms  and  C^j,^  are 
Coriolis  force  coefficients.  Each  of  these  Is  a polynomial  In  the  sines  and 
cosines  of  the  joint-angles,  the  link  lengths  and  masses.  Clearly  these 
could  be  pre-calculated  and  stored  In  lookup  tables  Indexed  on  t.  Such  tables 
would  be  of  dimension  n and  thus  manageable  In  terms  of  storage  space.  A 
little  more  calculation  Is  required;  namely,  n(n  -*■  l)/2  n multiplications 
and  n(n-»’l)/2’*‘n  additions  per  Joint.  We  call  thismethod  configuration  space  control, 
since  the  look-up  table  Is  Indexed  on  6,  the  configuration  of  the  manipulator. 

A* 

We  should  Immediately  add,  that  while  nominally  there  are  n dimensions 
In  configuration  space,  some  economy  of  storage  Is  possible  by  noting  that  the 
I^j  and  C^ji^  terms  are  not  functions  of  the  position  of  the  first  Joint;  that 
connecting  the  manipulator  to  Its  base.  If  In  addition  the  axis  of  this  Joint 
Is  parallel  to  the  gravity  vector  (as  Is  often  the  case),  the  G^  term  Is  also 
Independent  of  the  position  of  the  first  Joint.  Furthermore,  If  the  Important 
masses  In  the  last,  or  highest  numbered  link,  the  terminal  device,  are 
synmetrlcally  distributed,  then  the  equations  of  motion  do  not  depend  on  the 
position  of  the  last  Joint  either.  If  both  these  conditions  are  true,  the  stored 
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tables  need  only  be  of  dimension  (n  - 2),  a considerable  saving.  Further 
simplifications  may  apply  to  specific  classes  of  manipulators. 

Similarly,  the  storage  required  per  table  entry  can  be  economized 
when  It  Is  realized  that  the  Inertia  matrix  Is  syirmetrlc,  that  only  the 
upper  half  of  the  Coriolis  force  coefficient  matrix  Is  needed,  and  that 
there  exist  relationships  between  the  coefficients  C^j|^  and  It  takes  a 

little  more  work  to  exploit  the  fact  that  for  a given  manipulator  geometry 
many  of  these  coefficients  are  actually  zero,  or  so  small  as  to  be  negligible, 
as  can  be  seen  from  the  equations  we  presented  earlier  for  a three  link 
device  (where  only  10  of  a possible  18  terms  were  non-zero). 

We  have  now  explored  a spectrum  of  methods  for  computing  the  required 
joint  torques  (see  figure  7).  It  Is  our  contention  that  both  ends  of  the 
spectrum  represent  techniques  which  are  Impractical  and  that  the  configuration 
space  method  provides  a near  optimum  balance  between  storage  and  computational 
costs.  Note  for  example  that  state  space  control  requires  more  storage  capacity 
than  configuration  space  control  for  any  system  with  n > 1 and  m > 1. 

The  notions  of  the  Inverse  system  and  configuration  space  look-up 
can  now  be  brought  together  In  an  overall  system  like  that  shown  In  figure  8. 

If  one  does  not  take  advantage  of  the  economies  mentioned  above,  then 

about  n^(n  * 3)/2  multiplications  and  additions  are  required  per  calculation 

cycle.  If  each  dimension  Is  quantized  Into  m sections,  then  the  look-up 

table  has  a total  of  [n(n^l)(rH’2)  / 2]  m"  numeric  entries.  These  aumbers  are  large. 

but  manageable,  especially  In  view  of  recent  trends  In  the  cost  of  computer 

storage. 
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MISMATCHES  BETWEEN  THE  DYNAMIC  SYSTEM  AND  THE  MODEL. 

Glancing  at  figure  8,  one  notices  that  the  Input  to  the  system  Is  the 
angular  acceleration,  presumably  supplied  by  a trajectory  planner. 
Intuition  suggests  that  such  a system  Is  likely  to  suffer  from  the  111 
effects  of  approximate  numerical  differentiation  and  In  general  behave 
In  a fashion  that  has  the  •actual  Joint-angles  drifting  away  from  the 
desired  Joint  angles.  The  rate  of  accumulation  of  errors  will  depend  on 
how  accurate  an  Inverse  one  can  build  to  the  dynamic  system.  For  low 
speed  movement  It  appears  that  the  limiting  factor  In  this  regard  will 
be  friction,  which  tends  to  be  both  difficult  to  predict  and  not  a 
repeatable  function  of  Joint  angles  and  angular  velocities.  This  suggests 
that  we  have  to  augment  the  elegant  open-loop  system  with  sub-systems 
capable  of  correcting  for  small  departures  of  the  actual  trajectory  from 
the  desired  one. 

Some  form  of  negative  feedback  Is  needed.  Note,  however,  that 
feedback  plays  quite  a different  role  here  than  It  did  In  the  simple 
control  system  shown  earlier  for  a second-order  dynamical  system.  In 
that  situation,  feedback  produces  the  actuator  forces;  error  signal  are 
In  some  sense  the  prime  movers.  Here  feedback  Is  added  only  to  correct 
for  minor  departures  of  the  dynamical  system  from  the  model  used  In 
deriving  the  Inverse  system,  with  the  main  component  of  actuator  torque 
coming  from  the  open-loop  calculation.  For  this  reason  the  design  of  this 
feedback  system  Is  much  less  critical,  with  small  feMback  gains  acceptable 
and  consequently  there  need  by  little  concern  over  stability. 
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INTRODUCTION  OF  CORRECTIVE  FEEDBACK 

There  are  a nunber  of  alternate  ways  of  Introducing  feedback  to 
correct  for  the  departures  of  actual  position  discussed  In  the  previous 
section.  Perhaps  the  most  obvious  has  corrections  proportional  to  the 
errors  applied  to  the  Inputs  of  the  dynamic  system  (see  figure  9).  That 
Is,  the  actuator  torque  now  Is  the  sum  of  the  calculated  open-loop  torque 
required  to  follow  the  trajectory  and  terms  proportional  to  errors  In 
position  and  velocity.  Such  a system  would  differ  from  the  traditional 
control  system  In  that  the  Input  Is  first  passed  through  the  Inverse  sys- 
tem and  that  the  feedback  gains  would  be  much  smaller.  To  some  extent, 
this  kind  of  system  would  however  suffer  from  some  of  the  short-comings 
of  the  traditional  system,  unless  these  feedback  gains  were  at  least  ad- 
justed according  to  the  current  configuration. 

If  suitable  costs  can  be  associated  with  departures  from  the  correct 
trajectory  and  If  costs  can  be  assigned  to  control  Inputs,  then  optimal 
time-varying  feedback  gains  can  be  determined  using  the  techniques  of  modem 
control  theory  [18] . In  a system  with  more  than  one  degree  of  freedom,  one 
has  to  use  a feed-back  matrix.  This  too  could  be  conventionally  obtained 
from  a look-up  table  Indexed  on  the  configuration. 

A different  system  can  be  obtained  by  applying  the  error  signals  to  the 
Inputs  to  the  Inverse  system  Instead  (see  figure  10).  This  has  several  ad- 
vantages. First,  the  Input  to  the  overall  system  from  the  trajectory  plan- 
ner Is  now  composed  of  the  Joint  angles  and  the  angular  velocities  Instead 
of  the  angular  accelerations.  Secondly,  this  system  can  be  analyzed  more 
readily.  For  example.  If  the  Inverse  system  really  Is  an  exact  Inverse  for 
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the  dynamic  system,  then  their  cascade  connection  Is  simply  an  Identity 
system.  In  this  case,  the  overall  system  degenerates  Into  an  ordinary 
linear,  time-invariant  second-order  system.  The  designer  can  now  freely 
choose  the  response  by  picking  the  gains  o and  0 - that  Is,  the  poles 
can  be  arbitrarily  assigned. 

Noteworthy  Is  the  linearization  and  decoupling  of  degrees  of  free- 
dom obtained  In  this  fashion  [19].  In  a system  with  more  than  one  degree 
of  freedom,  feedback  can  now  be  applied  separately  to  Individual  degrees 
of  freedom,  that  Is,  a feedback  matrix  Is  not  required.  Furthermore,  the 
feedback  gains  do  not  depend  on  the  configuration  and  can  be  fixed.  A re 
malning  analytic  difficulty  Is  the  determination  of  the  effects  of  small 
differences  between  the  actual  device  and  the  dynamic  model  used  In  the 
derivation  of  the  Inverse  system. 


SUMMARY  ANO  CONCLUSIONS 


Straightforward  feedback  control  Is  unable  to  deal  correctly  with 
varying  effective  Inertias,  Joint  torque  coupling  and  Coriolis  forces 
encountered  In  high-speed  movements  of  mechanical  manipulators.  The  pre- 
cision of  manipulation  for  slower  movement  Is  similarly  limited.  Analysis 
of  the  dynamics  of  the  kinematic  chain  leads  to  equations  representing  an 
Inverse  system,  able  to  compute  required  joint  torques  from  desired  Joint 
accelerations  given  the  state  of  the  device.  Unfortunately  this  computa- 
tion Is  quite  unwieldy  and  essentially  useless  for  real  time  control  of 
devices  with  more  than  two  or  three  degrees  of  freedom.  On  the  other  hand. 
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performlng  the  computation  completely  by  look-up  in  a table  Indexed  on 
the  state  of  the  device  leads  to  a requirement  for  excessive  amounts 
of  memory. 

A compromise  on  this  space-time  trade-off  Is  a method  based  on 
configuration-space  look-up  tables.  These  precomputed  tables  are  of 
manageable  size  and  the  computations  performed  using  the  entries  found 
there  are  relatively  straightforward.  Each  computational  cycle  requires 
about  n (n  + 3)/2  arithmetic  operations  for  a device  with  n degrees  of 
freedom.  The  total  size  of  the  look-up  table  for  this  computation  Is 
less  than  [n  (n+1)  (n  + 2)/2]m”  If  each  dimension  Is  quantized  Into 
m segments. 
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I 1.  Outline  drawing  of  the  MIT-AI-VICARM  olectric  Manipulator.  This  Is  a 

typical  coMputar  controlled  device  with  six  degrees  of  freedoM.  DC 
torque  Motor  actuators*  potentiometers  for  position  readout  and 
tachometers  for  the  detenni nation  of  angular  velocities. 


order  Mechanical  system  with  fixed  properties.  The  feedback  gains  a 
and  0 are  selected  to  provide  stable  control.  Their  values  depend  on 
the  parameters  of  the  mechanical  system. 


Sb.  Block-dlagrM  of  Modified  open-loop  control  using  actual  state  rather 
than  predicted  state  In  the  calculation  of  the  Inverse. 


VIEW 


GcoMttry  of  • thrto  degrot-of- freedom  manipulator.  This  could  be  a 
diagrua  of  the  first  three  degrees  of  freedom  of  the  device  shown  In 
figure  1,  or  the  drawing  for  a "leg**  on  a locomotory  device. 
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7. 


Table  of  features  of  the  four  methods  for  calculating  actuator  torque. 
The  tMO  extremes  of  the  spectrum  do  not  represent  viable  computational 
techniques  because  of  excessive  computation  or  storage  requirement. 
Configuration  space  control  appears  to  provide  the  optimal  balance. 


Here  the  error  signals  are  applied  directly  to  the  actuators  after 
a^)11f1cat1on. 


